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(g) Verfahren zur Steuerung oder Regelung einer zu steuernden Einheit 

@ Es wird ein Verfahren zur Steuerung oder Regelung ei- 
ner zu steuernden Einheit vorgeschlagen,wobei in einem 
uberbestimmten System keine Vorauswahl von Mel^ro- 
Ben getroffen wird, sondern atle Mellgrdllen mit einer im 
Verfahren ermittelten Gewichtung zur Ermittlung eines 
Steuervektors u Berucksichtigung finden. 
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Beschreibung 



Die Erfindung betrifft ein Verfahren zur Steuerung oder Regelung einer zu steuernden Einheit, wobei die zu steuemde 
Einheit in Abhangigkeit eines aus einem AusgangsgroBenvektor ^ zu ermittebiden SteuergroBenvektor u beaufschlagt 
5 wird, 

wobei der SteuergroBenvektor u die Dimension n und der AusgangsgroBenvektor ^ die Dimension m aufweist und m und 
n jeweils groBer 1 sind, 

wobei der AusgangsgroBenvektor]^ implizit iiber die MaUixgleichung: 
10 ^ = A-u 

definierl ist, in der ^ den AusgangsgroBenvektor und A eine Steuermatrix bezeichnet, die sich aus den partiellen Ablei- 
tungen der AusgangsgroBen nach den EingangsgroBen, die entweder bekannt oder beispielsweise duich Tastsignale er- 
mittelbar sind, ergibt und 

15 wobei das Steuer- oder Regelungsproblem aufgrund m groBer n iiberbestimmt ist. Genaugenonunen ist die MaUixglei- 
chung y = A ♦ u nur eine Approximation (Modell) an die eigentliche Regelstrecke y = f • (u), wobei f eine u. U. unbe- 
kannte Funktion ist. Dieses Modell der Matrixgleichung y = A • u wird im folgenden vorausgesetzt. 

Bei Steuerungen oder Regelungen besteht haufig das Problem, daB mehr AusgangsgroBen als Resultat von Messun- 
gen, vorgegebenen Zustanden oder Informationen vorliegen als tatsachlich Freiheitsgrade in der Steuerung oder Rege- 

20 lung vorhanden sind. Es mussen dann MeBgroBen, Zustande oder Informationen beiseite gelassen werden, wobei die 
Auswahl, welche AusgangsgroBen nicht zur Anwendung kommen, sehr problematisch ist. Es sind auch analytische Me- 
thoden zur Losung eines derartigen uberbestinunten Systems bekannt, wobei diese auBerst aufwendig und daher im tech- 
nischen Anwendungsbereicb gerade in Echtzeitproblemen aufgrund der erforderlichen Rechenleistung nicht in Betracht 
kommen. 

25 Die Aufgabe der vorliegenden Erfindung besteht darin, die durch die Uberzahl der AusgangsgroBen vorhandene Red- 
undanz zur Ermittlung der SteuergroBen dadurch auszunutzen, daB keine MeBgroBe, etc., von vomherein ausgeschlossen 
wird. Gleichzeitig soil ein einfaches Verfahren vorgeschlagen werden, das mit vertretbaren Rechenaufwand derartige 
Steuer- und Regelungsprobleme in der praktischen Anwendung losen kann, 

Diese Aufgabe wird gelost mit einem Verfahren nach den Merkmalen des Anspruches 1 oder 9. 
30 In einer VeraUgemeinerung, die auch Losungen fiir den Fall eines unterbestimmten Steuer- oder Regelungsproblems 
bieteL, wird der SteuergroBenvektor unter Zuhilfenahme einer generalisierten pseudo-inversen Matrix mnittelt, gemafi 
den Merkmalen des Patentanspruchs 12. 
Ein Kemgedanke der vorliegenden Erfindung besteht darin, das iiber- oder unterbestimmte System in 

35 k= maA(ffl,/i)! 

min( /«,«)! abs{m - «)! 



60 



eindeutig losbare Untergleichungssysteme aufeugUedem und den Beitrag des i-ten Gleichungssystems mit einem Wich- 
tungsfaktor zu versehen, der sich aus der Steuermatrix A ermitteln laBt. In Patentanspruch 1 ist dieser Grundgedanke in 
40 Form eines Algorithmus fur den Fall des uberbestimmten Problems (m groBer n) definiert. 

In einer zweckmaBigen Ausgestaltung wird der Wichtungsfaktor wi fur den BeiU^g des i-ten Gleichungssystems nicht 
aus der kompletten Steuermatrix A, sondem aus der dem i-ten Gleichungssystem zugeordneten Untermatrix Aj ermittelt, 
da gerade die Untermauix Ai die das i-te Gleichungssystem bezeichnenden Informationen enthalt. 

In einer einfachen und zweckmaBigen Ausgestaltung laBt sich der Steuervekior u aus der Summe der mit den zugeord- 
45 neten Wichtungsfaktoren Wi multiplizierten Untersteuervektoren u, ermitteln, 

^ (Uj • Wj) 

50 Dabei mtissen geeignete MaBnahmen getrofFen werden, daB die Werte im Nenner weder 0 noch oo erreichen. 

Es sind prinzipiell verschiedene Verfahren zur Ermitdung eines Wichtungsfaktors aus der durch die Steuermatrix A 
vorgegebenen Information denkbar. In einer ersten altemativen konkreten Ausgestaltung des vorliegenden Verfahrens 
wird als Wichtungsfaktor Wi fiir das i-te Gleichungssystem der absolute Betrag der Determinanle der i-ten Untermatrix Aj 
verwendet: Wi = ldet(Ai)l. 

55 In einer anderen altemativen Ausgestaltung kann der Wchtungsfaktor Wj fiir das i-te Gleichungssystem aus einer Kon- 
diiionszahl der i-ten Untermatrix, beispielsweise aus dem reziproken Wert der Zweier-Norm-Konditionszahl 

1 

vv. =- 



Ki(A,) 



ermittelt werden. 

Ein besonderer Vorteil des erfindung sgemaBen Verfahrens ist darin zu sehen, daB die den Wichtungsfaktoren wj zu- 
grunde liegende Steuermattix A und die daraus resultierenden Unterraatrizen Aj zu verschiedenen Zeiten im ProzeB neu 
bestinmit werden konnen. Hierdurch kann noch im laufenden ProzeB die Genauigkeit zu verschiedenen Zeitpunkten an- 
65 gepaBt werden. 

In einer weiteren vorteilhaften Ausgestaltung wird das Verfahren zur Bestimmung des jeweils giiltigen Steuervektors 
u anhand eines aktualisierten AusgangsgroBenvektors ^ iterativ durchgefuhrt. Durch die beim vorliegenden Verfahren 
vergleichsweise geringe Rechenleistung kann eine Vielzahl von iterativen Verfahrensschritten aneinander gereiht wer- 
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den. 

Nach einem besonders vorteilhaften Aspekt der vorliegenden Erfindung sind die Wchtungsfaktoren Wi so definiert, 
daB cine Untermenge von AusgangsgroBen y mit potentiell groBeren systematischen Fehlem durch die vorzugsweise 
auch im laufenden Verfahren durchfiihrbare Gewichtung im Vergleich zu einer Untermenge von AusgangsgroBen y mit 
potentiell geringeren systematischen Fehlem woiiger B^cksichtigung linden. S 

Ein besonderer Aspelct des vorliegenden Verfahrens, der auch unabhangig beansprucht wird, besteht darin, daB in ei- 
nem uberbesiiinmten System keine Vorauswahl von MeBgroBen getrofifen werden muB, sondem vielmehr alle MeBgro- 
Ben mit einer im Verfahren ermittelten Gewichtung zur Ermittlung eines Steuervektors u Bedicksichtigung finden. Wah- 
rend beim Stand der Technik MeBgroBen unberucksichtigt bleiben miissen, um das System auf ein losbares Unteiglei- 
chungssystem zuriickzufuhreo, werden erfindungsgemaB alle Untergleichungssysteme mit einer speziellen, im allgemei- 10 
nen jeweils von Null verschiedenen Gewichtung beriicksichtigt 

In einem konkrelen Anwendungsbereich kann das Verfahren zur Steuerung von Maschinen oder Robotem eingesetzt 
werden, die mindestens eine bewegliche Komponente wie einen Greifarm aufweisen und wobei der AusgangsgroBen- 
vektor y zumindest in zwei Dimensionen physikalische Entfemungen beinhaltel. Der Steuervektor u steuert daim einen 
Bewegungsablauf der beweglichen Komponente, insbesondere des Greifarms. 15 

Das Verfahren erhoht die Leistungsfahigkeit, insbesondere Robustheit, Adaptivitat, Geschwindigkeit, Zuverlassigkeit 
und Genauigkeit von MIMO(Multible-Input-Multible-Output)-Syslemen, wobei der AusgangsgroBenvektor y der Di- 
mension m Zustande, Informationen, MeBergebnisse, etc., beriicksichtigen kann und der SteueigroBenvektor u der Di- 
mension n Zustande, Informationen, Aktionen, etc., definieren kann. 

In einer generalisierten und gleichzeitig formalisierten Fassung, die nicht nur auf uberbestimmte Systeme, sondem 20 
auch auf unterbestimmte Systeme anwendbar ist, wird eine generalisierte pseudo-inverse Matrix A* definiert, die sich als 
Summe eines MaUizenproduktes (Pi A)"^ Pi im Falle des uberbestimmten Systems (m groBer n) jeweils multipUziert mit 
einem Wchtungsfaktor und Pj (A P, jeweils im Fall des unterbestimmten Systems m kleiner n eigibt, wobei der Wich- 
tungsfaktor im Fall des uberbestimmten Systems m groBer n durch [abs(det(Pi A))]^ und im Fall des unterbestimmten Sy- 
stems m kleiner n durch [abs(det(APi))]^ definiert ist. Durch diesen Formalismus, der die Moore-Penrosche Matrix oder 25 
"pseudoinverse" Matrix als Spezialfall fur q gleich zwei enthalt, lassen sich sowohl iiber- als auch unterbestimmte Sy- 
steme losen. 

Im konkreten, uberbestimmten Fall lautet die entwickelte generaUsierte pseudo-inverse Mattix: 

_ £(PiA)-'Pi[abs(det(PA))]'' 30 

A /in>n) ~ 

£ [abs (de^APi)]" 

Im Fall des unterbestimmten Systems m kleiner n lautet die entwickelte generalisierte pseudo-inverse Matrix: 

_ ZPiCAPir'tabsCdetCPjA))]" 35 

A fni<o) — 

£ [abs (det(APj)f 

Es hat sich uberraschenderweise gezeigt, daB die Anwendung dieser generalisierten pseudo-inversen Matrix im Fall m 
= n - 1 mit g = 1 die oo-Norm von r = A • u - y direkt minimiert, wobei die oo-Norm wie folgt definiert ist: llxlloo = max 
{Ixil: i = 1, . . . n). Dies war bisher selbst mit aufwendigen Verfahren nicht moglich, ist aber in sehr vielen Problemstel- 40 
lungen besonders vorteilhaft und sinnvoU. Anstelle der oo-Norm kann auch eine andere Norm Anwendung finden. Dabei 
sind die Hilfsmatrizen Pj im uberbestimmten Fall (m > n) derart definiert, daB alle moglichen Kombinationen des Weg- 
lassens von (m - n) Reihen im AusgangsgroBenvektor ^ bzw. im unterbestinmiten Fall (m < n) alle moglichen Kombi- 
nationen des Weglassens von (m - n) Zeilen beim Steuervektor u ermoglicht werden. 

Die Erfindung wird nachstehend auch hinsichtlich weiterer Merkmale und \forteile auch unter Wurdigung von Spezi- 45 
alfaUen und Ausfuhrungsbeispielen noch weiter erlautert. 

Das Verfahren ist anwendbar auf alle Systeme, wie sie in Abb. 1 veranschaulicht sind, welche wiederum auch Nahe- 
rungen an beliebige nichtlineare Systeme darsteUen konnen. 

Dabei soli ein Steuervektor u so bestimmt werden, daB die Antwort des Systems den Ausgangsvektor y (mit hoherer 
Dimension; m) ergibt. Mit A ist dabei die Steuermauix beschrieben, deren Spalten- und Zeilenzahl aufgrund m groBer n 50 
nicht iibereinstimmt. 

So ist exemplarisch in Abb. 2 der Fall der Regelung eines nichUinearen Systems gezeigt, bei dem Redundanz im ge- 
schlossenen Regelkreis ausgenutzt wird. Das System ist in der Steuermalrix A linearisiert. Das erfindungsgemaBe \fer- 
fahren der gewichteten Beriicksichtigung aller Unteigleichungssysteme wird hier auf eine Regelabweichung e anstelle 
des AusgangsgroBenvektors y angewandt. Somit lassen sich ein SoUwertvektor und ein MeBgroBenvektor (in diesem 55 
Fall RegelgroBenvektor) hoherer Dimension als der StellgroBenvektor veraibeiten mit den weiter unten beschriebenen 
Vorteilen. Mit K wird hierbei eine iibliche Verstarkungsmatrix bezeichnet. Mit den Moglichkeiten der digitalen Rechen- 
lechnik wird die Anwendung auf zeitdiskrete Systeme bzw. auf Systeme, in den Korrekturen in Echtzeit oder nahezu in 
Echtzeit notwendig sind, mogUch. Zwei Beispiele von Anwendungen im zeitdiskreten Systemen sind in den Abb. 3 und 
4 dargestellt, wobei in Abb. 3 die Ausnutzung von Redundanz in einem zeitdiskreten Regelkreis mit inkrementeller 60 
SteUgroBe und in Abb. 4 die Ausnutzung von Redundanz in einem zeitdiskreten Regelkreis mit inkrementeller Regel- 
gFoBe veranschaulicht ist. Der FaU der inkrementeller RegelgroBe (Abb. 4) wird in der nachfolgenden Beschreibung 
noch eingehender behandelt 

Bei Systemen, die mehrere AusgangsgroBen und mehrere SteuerungsgroBen besitzen, wird haufig ein Ergebnis als Lo- 
sung eines Gleichungssystems (bzw. einer Matrizengleichung) gesucht. Stinunt die Anzahl der. Unbekannten mit der 65 
Anzahl der (voneinander unabhangig^) Gleichungen iiberein, wild i.d.R. problemlos eine Losung gefunden. In infor- 
mationsverarbeitenden und technischen Systemen stehen jedoch haufig mehr AusgangsgroBen (in vektorieUer Notation: 
eine AusgangsgroBe hoherer Dimensionalitat) zur Verfugung bzw. konnte ohne groBeren Mehraufwand zur Verfiigung 
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Losung der Aufgabe erforderlich sind, Stehen somit mehlJBchungen zur Verfiigung 
als unbedingt notig, kommt dies einer Redundanz gleich, die sich sinnvoll zur Erhohung der Leistungsfahigkeit des Sy- 
stems nutzen lieBe, wenn es dazu entsprechende Verfahren gabe. 

Als Verfahren zur Bestimmung des Ergebnisses solcher Gleichungssysteme ist, wie schon erwahnt, die, Bestimmung 
5 der gesuchten GroBen iiber die Moore-Penrose'sche verallgemeinerte Inverse ("Pseudoinverse") bekannt. Dire Imple- 
mentation ist jedocb sehr aufwendig and ihre Komplexitat so hoch, dafi maschinelleRessourcen iiberlastet und Ecbtzeit- 
f^igkeit in der Regel nicht gegeben sind. £s existieien weitere \^rsuche der Bestimmungen von Eigebnissen aus sol- 
chen Systemen, die jedoch nicht an die Leistungsfahigkeit der Losung iiber die Pseudoinverse heranreichen. Als Konse- 
quenz werden die redundanten Grofien hau&g nicht verwendet und mogliche V>rteile somit nicht genutzt. 
10 Sind von vomherein mehr HngangsgroBen als notwendig vorhanden, soil aber nur die minimal notwendige Anzahl 
verwendet werden, zeigt sich ein weiterer Nachleil: Es miissen EingangsgroBen weggelassen werden. Je nachdem, wel- 
che EingangsgroBen weggelassen werden, kann dabei das Ergebnis sehr unterschiedlich sein. Will man auf diesem Weg 
arbeiten, muB man im voraus bestimmen, welche EingangsgroBen sinnvoUerweise weggelassen werden konnen, man 
muB ihre Eignung also a priori kennen. Dies kann jedoch aufwendig, wenn nicht gar unmoghch, sein. Dariiber hinaus 
15 kann sich die Eignung insbesondere unter wechselnden Bedingungen, auch wahrend des Betriebs, massiv andem. Dem- 
zufolge ist das Ergebnis u. U. Gliickssache. 

Es sei nochmals erwahnt, daB als EingangsgroBen in erster Linie MeBgroBen in Betracht kommen. Es konnen aber 
auch andere GroBen wie SchatzgroBen, statische Randbedingungen, Nachrichten, statistische Informationen, etc., ganz 
Oder teilweise als EingangsgroBen in Betracht kommen. 
20 Das Verfahren nach der Erfindung zeichnet sich dadurch aus, daB vorhandene oder erreichbare Redundanz nutzbar ge> 
macht wird. Dies schlieBt ein, daB das Ergebnis ebenso gut oder besser als das ohne Nutzung von Redundanz crzielte ist, 
und daB die Realisierung vergleichsweise einfach ist. Das Verfahren laBt sich ohne ubermaBig hohen Aufwand in der 
Nutzung von maschinellen Ressourcen (z. B. Rechenleistung) bzw., wo dies bedeutsam ist, in der Regel auch in Echtzeit 
durchfuhren. 

25 Das Verfahren zeigt gute und zuverlassige Ergebnisse, auch wenn die Anordnung massiv gestort wird. Obwohl bei An- 
wendung des Verfahrens alle EingangsgroBen beriicksichtigt werden, wird das Gesamtergebnis praktisch nicht durch Er- 
gebnisse aus weniger geeigneten Satzen von EingangsgroBen beeintrachtigt, was bei anderen Verfahren durchaus der 
Fall sein konnte. 
Hauptvorteile sind: 

30 

- Es ist keine Auswahl von Messungen im voraus notig. 

- Beliebige Storungen in Aufbau und Anordnung des Systems werden toleriert 

- Hne selbstandige Adaption des Systems an Anderungen wird gewahrleistet. 

- Hn Einsatz ist bei kalibrierungsfreien Robotem oder allgemein in Systemen moglich, iiber die kein exaktes Mo- 
35 del bzw. exakte Kalibrierung existiert, wobei das Verfahren naturgemaB nicht auf derartige Anwendungen be- 

schrankt ist. 

Ausnutzung von Redundanz bielet eine Erhohung der Leistungsfahigkeit selbst gegeniiber Systemen unter Nutzung 
der am besten geeigneten EingangsgroBen. Sie auBert sich in: 

40 

- Geschwindigkeit sowie 

- Zuverlassigkeit und Genauigkeit. 

Die Ausnutzung von Redundanz durch das Verfahren belastet die rechnerischen Ressourcen nur geringfugig mehr ge- 

45 geniiber einem Betrieb unter Verzicht auf Ausnutzung der Redundanz. 

Als ein Anwendungsbeispiel wird die Verbesserung des sichtbasierten Greifens eines Objekts durch einen kalibrie- 
rungsfreien Roboter nachfolgend erlautert. Das hier erlauterte Verfahren zur Steuerung eines Roboters nutzt die Redun- 
danz der MeBdaten. Zuverlassigkeit und Anspassungsfahigkeit der Robotersteuerung werden so verbessert. Um sich das 
Problem vor Augen zu fiihren, kann man sich einen Aufbau von zwei identischen Kameras vorstellen, welche eine Szene 

50 beobachten. Die Kameras sind genau parallel zueinander aufgestellt, so daB die Elipolarlinie parallel zur X-Achse beider 
Bildkoordinatensy Sterne verlauft. In diesem Fall enthalten die beiden zu den Y-Koordinaien der Kameras gehorenden 
Gleichungen (bei AuBerachtlassung von Rauschen) die gleiche Information. Das Weglassen einer dieser beiden Glei- 
chungen wiirde keinen Verlust bedeuten. Jedoch wenn MeBrauschen vorhanden ist, stellt bereits die Mittelung beider 
Gleichungen eine wesentliche Verbesserung gegeniiber dem Weglassen einer Kamerainformation dar. 

55 Dagegen wiirde im vorigen Beispiel das Weglassen einer der beiden anderen Gleichungen alle Tiefeninformationen 
beseiiigen und wiirde (bis auf das Rauschen) ein unterbestimmtes System eigeben, das nicht ohne weitere Zusatzbedin- 
gungen gelost werden kann, da von drei Gleichungen zwei mit selben Informationsgehalt bei drei Unbekannten vorhan- 
den ware. Wenn Rauschen voriianden ist, laBt sich meistens eine Losung ermitteln, die aber praktisch wertlos ist. 
Wenn die Kameraanordnung nicht exakt, sondem lediglich naherungsweise der vorbeschriebenen enlspricht, so wer- 

60 den die X-Gleichungen eine relative Hefeninformation enthalten und das Weglassen einer von ihnen fiihrt zu einem Sy- 
stem, das eine Losung aufweist, bei dem jedoch schon leichte Veranderungen der Ausgangsdaten groBe Anderungen der 
Losung bewirken. Die Losung wird daher relativ verrauscht sein und keine gute Grundlage fur eine Robotersteuerung 
bieten. Wenn die Kameraanordnung behebig und nicht exakt bekannt ist, fuhrt das Weglassen einer der vier Gleichungen 
zu Ergebnissen mit voriier nicht einschatzbarer (Jualitat. 

65 Der AusgangsgroBenvektor y besteht hier aus dem Distanzveklor d zwischen Greifer und zu greifendem Objekt in 
zwei Kamerabildem (Abb. 5). Da dieser zum Greifen des Objekts minimiert werden soil, ist der SollgroBenvektor x der 
Nullvektor, und zusatzlich zur Darstellung in Abb. 4 wird die Regelabweichung (in diesem Fall -d) liber eine Totzone 
gefuhrt. Die Verstarkungsmatrix K ist die Einheitsmatrix der Dimension (n, n). 
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Zum Greifen punklftJUHfir Objekte sind drei Freiheitsgrade des Manipulators erfo^Hch, deshalb werden die Ge- 
lenke Jti bis Jtj aktiv angesteuert (Abb. 6). Da ein Steuemvortvektor an diesem Manipulator immer eine Relaiivbewe- 
gung zur vorherigen Lage verursacht, wird die RegelgroBe inktementiert. Mit der vorhandenen vierten Dimension in der 
Bildinfotmation ergibt sich also fiir die Regelung die Bestinunung des Steuerwortvektors u taet c, aus 

-d = Jc. (1) 
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wobei A hier als Jacobi-Matrix J auflritt. 35 

Es laBt sich aus (1) ein System von jeweils exakt bestimmten Gleichungssystemen dadurch erreichen, daB jeweils m - 
n Zeilen fur die AusgangsgroSen d auBer Betracht gelassen werden. Dies kann auf k unterschiedlichen Weisen erfolgen, 
wobei jeweils eine exakte Losung fiir C[ erzielt wird: 



-di = Ji-Ci 
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m! 

k= ^ 

n! (m-n)! 45 

Im Idealfall soUten alle diese Systeme die gleiche (richtige) Losung ergeben. In der Praxis ist jede Gleichung beein- 
fluBt vom jeweils zugeordneten MeBrauschen, so daB die einzelnen Losungen sich voneinander unterscheiden. Einige 
der Untergleichungssysteme konnen so schlecht konditioniert sein, daB sie Losungen eigeben, die vonangig auf MeBrau- 
schen beruhen. 50 

Urn den Vorteil aus der gesamtverfiigbaren Information zu nutzen, wird der Steuervektor c ermittelt als gewichtetes 
Mittel aller Losungen der reduzierten Untergleichungssysteme: 



55 



S Wi 

Hierin soUten die "^chtungsfaktoren Wj die "Qualitat" des zugeordneten Untergleichungssystems widerspiegebi. Da 
keinerld weitere Annahmen getroffen werden, ist uber das Gleichungssystem 

-di = Ji.Ci 60 

kein weiteres Wissen verfiigbar. Daher konnen die Wichtungsfaktoren nur aus den Gleichungssystemen selbst erhalten 
werden. Als Indikator fiir die Qualitat der jeweiligen Untergleichungssysteme kann die Konditionszahl k Venvendung 
finden. Es ist ein numerisches MaB fiir die Kondition eines Problems, die sich hier aus Jj ermitteln laBt. Im vorliegenden 
Fall wurde die Zweier-Norm-Konditionszahl K2 verwendet. Als Alternative kann aber auch ein Wichtungsfaktor aus dem 65 
Absolutbetrag der Determinante 

Wi=ldet(Ji)l 
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errechnet werden. 

Da die Errechnung der Konditionszahl einen hoheren Rechenaufwand als die Berechnung der Determinante erfordert, 
wird gerade fiir Echtzeitanwendungen die Verwendung eines Wichtungsfaktors basierend auf dem Absolutwert der De- 
terminante bevorzugt. 

Im Ergebnis werden in beiden Fallen alle Gleichungen und damit alle AusgangsgroBen bzw. MeBgroBen der Berech- 
nung des Steuervektors verwendet. Dies ist von Vorteil, da sogar eine sehr verrauschte oder redundanteMeBgroBe iirnner 
Docb nUtzIiche Information enthalten kann. Wenn jedoch ein Unteigldchungssystenti keinen vollen Rang erreicht, tragi 
es praktisch nicht zum Endeigebnis bei. Daber werden Ergebnisse von "schlechten" Untergleichungssystemen im End- 
ergebnis nur mit einer sehr geringen Gewichtung beriicksichtigt. 

Beide Verfahren zur Berechnung von Wi gestatten die Losung von Problemen mit n > 2 im konkreten Fall von m = 4 
und n = 3 exislieren k = 4 Moglichkeit des Weglassens jeweils einer Zeile in d und J, es werden also bei jeder Steuerwort- 
berechnung, deren Ausfiihrung der Distanzvektor zum Verschwinden bringen sollte, vier Teilsysteme gebildet, deren 
Teillosung berechnet und abschlieBend durch das erfindungsgemaBe Wichtungsv^ahren miteinander zum auszugeben- 
den Steuerwort bzw. Steuerveklor verknupft. 

Mit zwei verschiedenen experimentelien Anordnungen wurden systematische Untersuchungen voigenommen: Bei der 
ersten Anordnung waren beide Kameras in etwa gleicher Hohe mit ungefahr gleichem horizon talen Blickwinkel ange- 
ordnet Bei der zwei ten wurden sie zur Modellierung einer starken Storung unbekannter Art in der Hohe gegeneinander 
verschoben und die Blickwinkel verandert. Dies wird anhand der Abb, 6, in der eine schematische DarsteUung des Ro- 
boters veranschaulicht ist, sowie in der Abb. 7, die einen Blick auf den Roboter und das Objekt zeigt, veranschaulicht. 
Das in Abb. 7 eingeblendete Koordinatensystem wird hier nicht benutzt, sondem dient lediglich zur Veranschaulichung 
des vorliegenden Steuerungs- bzw. Regelungsproblems. 

Hierbei muB keinerlei theoretisches Modell und auf keinen Fail quantitatives Wissen iiber die Mechanik, die Kinema- 
tik, die Sensoren oder die Steuercharakteristik des Roboters vorliegen. 

In typischen Situationen wurden d und J in beiden Anordnungen gemessen. AnschlieBend wurden Storungen in Form 
von MeBrauschen simuliert und die Reaktionen der Teilsysteme, in denen eine Information weggelassen worden war, so- 
wie des Gesamtsystems unter Ausnutzung der Redundanz in Form der erfindungsgemafien W^chtungsverfahren in ihrer 
Auswirkung auf das zu berechnende Steuerkommando untersucht. Es zeigt sich, daB Teilsysteme, in denen wichlige In- 
formationen weggelassen worden waren, in beiden Fallen schlechte bis sehr schlechte Ergebnisse, Teilsysteme, in denen 
weniger wichtige Informationen weggelassen worden waren, gute Eigebnisse, und das Gesamtsystems unter Ausnutzung 
des erfindungsgemaBen Wichtungsverfahrens mindestens so gute, z. T. bessere Eigebnisse lieferten als letztgenannte. 
Abb. 8 und die nachstehende Tabelle 1 belegen dies. 
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TabeUe 1 

Die Standardabweichungen der Greifeipositionen in den Simulationen 





Standardabweichung [mm] 




X 


Y 


Z 


gesamt 


ofindungsgemiOes Wichtungsverfahrea 


1.68 


1,97 


2.08 


3,32 


d| unberQcksichtigt' 


1,62 


27,53 


13,76 


30,82 


unberticksichtigt 


1,44 


2.11 


2,92 


3.88 


d3 unbenicksicbtigt 


19,70 


85.51 


12,05 


88,57 


d4 unberiicksichtigt 


1.43 


1,81 


2,90 


3,71 



Die wichtigsten Ergebnisse aus den durchgefiihrten Experimenten werden kompakt in Tabelle 2 dargestellt. 

Die wichtigsten Werte sind die in der zweiten Spalte angegeben. Sie kennzeichnen die Anzahl der Stellschritte, die 
notwendig sind, um eine geeignete Zwischenposition oberhalb des Objekts zu erreichen, von der aus in ofFener Steue- 
rung zugegrifFen werden kann. Ebenfalls wichtig ist die Standardabweichung dieser Werte in der dritten Spalte. Beide 
Spalten sind immer dann sinnvoU fiir die Beurteilung, wenn in den letzten beiden Spalten annehmbare Werte erzielt wur- 
den. Ist dies nicht der Fall, so konnte die Greifaufgabe zu selten erfuUt werden, um das Kriterium der Anzahl der Stell- 
schritte sinnvoll heranzuziehen. Die letzten beiden Spalten unterscheiden sich dadurch, dafi in der letzten nur die Anna- 
herung an die Zwischenposition und in der vorletzten der gesamle Greifvorgang einschlieBlich des Zugreifens ohne 
Riickkopplung betrachtet werden. In diesen Spalten sollte nur beurteilt werden, ob gute Werte erreicht wurden (10,0 ent- 
spricht 100%), und nicht, wie gut sie tatsachlich waren, da es aufgrund anderer Effekte, die nicht Gegenstand dieser Be- 
trachtung sind, z. T. zu erheblichen MeBfehlem kam, wodurch der Greifvoigang in bestimmten Fallen komplett ausfiel 

£s zeigten sich folgende Eigebnisse: 
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TabeUe 2 

Ergebnisse aus Experimenten unter Weglassen von Informationen verglichen zur Nutzung von Redundanz durch De- 
terminanten-gewichtete Mittelwertbildung bei unterschiedlichen Anordnungen. Der Arbeitsbereich war in Quadrate ei- 
ner Kantenlange von 3,5 cm eingeteilt worden, innerhalb derer das zu greifende Objekt jeweils lOmal zufallig positio- 
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weiligen Quadrate ermittelten Werte wurden zur Berechnu^P&r Weite in den Tabellenfel- 
dem verwendet. Felder ohne verfiigbare Werte sind durch k. W gekennzeichnet. 



Mittelwert erfolgreicher AnnaherunRen 










Mittelwert erfolgreicher Greifvorgange 










Standardabweichung der Anzahl von Stellschritten 








Mittelwert der Anzahl notwendiger Stellsdiritte 








erste Serie: Kameras auf unterschiedlicfaer H5he 


erfindungsgemaBes Widktungsverfahren 


2.01 


0.41 


9,73 


9,73 


d| unberQcksichtigt 


3.42 


1,27 


4,41 


8,14 


di xmberiicksichtigt 


2.15 


0,50 


9,73 


9,82 


d] unberiicksichtigt 


, 3.4 


1.07 


4,41 


7,27 


d4 unberQcksichtigt 


2.13 


0,46 


9.27 


9,86 


zweite Serie: Kameras auf unterschiedlicher H5he 


erfmdungsgemsiBes Wichtungsverfabren 


1,08 


0,14 


8,91 


8,91 


d| unberiicksichtigt 


k-W. 


k.W. 


0 


0 


dj unberiicksichtigt 


1,23 


0,16 


9,45 


9,91 


dj unberiicksichtigt 


1.35 


0,04 


3,1 


4.2 


d4 unberiicksichtigt 


1.93 


0.27 


6,5 


10.0 



- Das Verfahren zeigt gute und zuverlassige Ergebnisse, auch wenn die Anordnung massiv gestort wird. 

- Beim Weglassen von MeBgroBen kann das Ergebnis sehr unterschiedlich sein. Wollte man auf diesem Wege ar- 
bdten, miifite man im voraus bestimmen, welche GroBen sinnvollerweise weggelassen werden konnen, man muB 
ihre Eignung also a priori kennen. Dies kann jedoch aufwendig, wenn nicht gar unmoglich sein, dariiber hinaus 
kann sich die Eignung insbesondere unter wechselnden Bedingungen, auch wahrend des Betriebes, massiv andem. 
Demzufolge ist das Ergebnis u, U. Gluckssache. 

- Obwohl beim erfindungsgemaBen Wichtungsverfabren alle individuellen Losungen benicksichtigt werden, wird 
das Gesamtergebnis nicht durch Ergebnisse weniger geeigneter Teilsysteme beeintrachdgt, was bei anderen Verfah- 
ren durchaus der Fall sein konnte. Hauptvorteiie sind: 

- Es ist keine Auswahl von Messungen im voraus notig. 

- Beliebige Storungen in Aufbau und Anordnung des Systems werden toleriert. 

- Da die Gewichle jedesmal neu berechnet werden, wenn sich die Jacobi-Matrix andert, wird eine selbstan- 
dige Adaption des Systems an Anderungen gewahrleistet. 

- Ausnutzung von Redundanz bietet eine Erhohung der Leistungsfahigkeit: 

- In der ersten Anordnung sichtbar an der geringeren Anzahl an Stellschritten, auch wenn die Verbesserung 
bier noch recht gering ist. 

- Sehr deutlich ist diese Verbesserung hingegen mit 1,08 Stellschritten gegeniiber 1,23 des besten (und eigent- 
lich einzig tauglichen) Teilsystems in der zweiten Anordnung. 

- Die erhohte Leistungsfahigkeit durch das erfindungsgemaBe Wichtungsverfabren auBert sich u. a. durch: 

- Geschwindigkeit, da weniger SteUschritte erforderlich sind, und 

- Zuverlassigkeit, da weniger SteUschritte eine hohere Genauigkeit bei der Ausfuhrung der einzelnen SteU- 
schritte indizieren. 

- Die Ausnutzung von Redundanz durch erfindungsgemaBes Wichtungsverfabren ermoglichte weiterhin Echtzeit- 
betrieb. 

Nach einem weiteren Gedanken der vorUegenden Erfindung wird eine generaUsierte pseudo-inverse Matrix einge- 
fuhrt, die mit leichten Abandeningen eine gewichtete Einbeziehung aUer Untergleichungssysteme sowohl im iiberbe- 
stimmten FaU m > n als auch im unterbestimmten Fall m < n schafft. Hierzu wird ein fur das i-te Unteigleichungssystem 
reprasentatives Matrizenprodukt mit einem fur das i-te Unteigleichungssystem reprasentativen Wichtungsfaktor multi- 
pliziert und anschlieBend uber aUe k-Gleichungssysteme summiert, wobei die so erhaltene Matrix noch uber die Wich- 
tungsfaktoren aller k-Gleichungen skaliert wird. 

Das Matrixprodukt fiir den iiberbestinamten FaU m > n lautet fur das i-te Gleichungssystem (Pi A)"^ Pi , wobei Pi Hilfs- 
maliizen sind derart, daB aUe mogUchen Kombinationen des Weglassens von (m - n) Reihen im AusgangsgroBenvektor 
y ermogUcht werden und eine vorangesteUte MultipUkadon mit der Steuermatrix A durchgefuhrt wird. Fiir den Bei- 
spielsfall m = 4 und m = 3 lauten die Hilfsmatrizen P(i): 
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^2 = 



0 1 

0 0 
0 0 



Im unterbestimmten Fall m < n ist das Matrizenprodukt durch Pi(APi definiert, wobei die Hilfsmatrizen Pi derart 
aufgebaut sind, daB alle mogllchen Kombinationen des Weglassens von (m - n) Zeilen beim Steuervektor u erreicht wer- 
den und eine nachgeordnete Multiplikation mil P durchgefuhrt wird. 

Es ist zu beachten, dafi die generalisierte pseudo-inverse Matrix fur den Unterfall q = 2 der Moore-Penrose'schen Ma- 
10 trix entspricht, die bereits bekannt ist ErfindungsgemaB werden daher die voigenannten generalisierten pseudo-inversen 
Matrizen fiir q ^ 2, q ^ C beansprucht Es ist nocb aazumerken, daB die bereits bekannte Moore-Penrose'sche Matrix 
alle vier Penrose^Bedingungen erfullt, namlich 

(PI): AA-^A = A; (P3): AA"^ = (AA')* 
15 (P2): A-^AA-^ = A; (P4): A'^A = (A'^A)* 
(A"" bedeutet die hermitische Matrix zu A) 



wohingegen die generalisierte pseudo-inverse Matrix nach der Erfindung A* im iiberbestimmten Fall m > n nur die Glei- 
chungen Pi, P2 und P4, nicht jedoch die Gleichung P3 erfullt. A* kann daher auch als { 1, 2, 4) Inverse zu A bezeichnet 
20 werden. 

Im unterbestimmten Fall m kleiner n erfullt die pseudo-inverse Matrix A* die Penrose-Bedingungen Pi, P2, P3, nicht 
jedoch P4 • A* kann daher als { 1, 2, 3} inverse Matrix zu A bezeichnet werden. 

Das erfindungsgemaBe Verfahren ist in seiner Anwendung nicht auf das Feld der Steuerung oder Regelung beschrankt 
Vielmehr kann das erfindungsgemaBe Verfahren auch fUr aUgemeine Anwraidung, wie beispielseise fiir die Datengewin- 
25 nung eingesetzt werden. 



Patentanspriiche 

1. Verfahren zur Steuerung oder Regelung einer zu steuemden Einheit, wobei die zu steuemde Einheit in Abhan- 
30 gigkeit eines aus einem AusgangsgroBenvektor ^ zu ermittelnden SteuergroBenvektor u beaufschlagt wird, 

wobei der SteuergroBenvektor u die Dimension n und der AusgangsgroBenvektor ^ die Dimension m aufweist und 
m und n jeweils groBer 1 sind, 

wobei der AusgangsgroBenvektor ^ implizit uber die Matrixgleichung: 
35 x = Au 

definiert ist, in der y den AusgangsgroBenvektor und A eine Steuermatrix bezeichnet, die sich aus den partiellen Ab- 
leitungen der AusgangsgroBen nach den EingangsgroBen, die entweder bekannt oder beispielsweise durch Ikstsi- 
gnale ermittelbar sind, ergibt und 
40 wobei das Steuer- oder Regelungsproblem aufgrund m groBer n uberbestimmt ist, 

dadurch gekennzeichnet, 
daB 

^ _ max(in,n)! 

min(m,n)! abs(m-n)! 

Untergleichungssysteme gebildet werden, und zur Ermittlung des Steuervektors u alle k Gleichungssysteme mit ei- 
nem anhand der Steuermatrix A gebildeten ^^^chtungsfaktor wj , i E 1, . . k beitragen. 

2. Verfahren nach Anspruch 1, dadurch gekennzeichnet, daB der ^chtungsfaktor wi fiir das i-te Gleichungssystem 
50 aus der zugeordneten UntermaUix Ai ermittelt wird, 

3. Verfahren nach Anspruch 1 oder 2, dadurch gekennzeichnet, daB der Steuervektor u aus der Sunmie der mit den 
zugeordneten Wichtungsfaktoren Wi multiplizierten Untersteuervektoren Ui ermittelt wird: 



wobei zusatzlich geeignete Absicherungen gegen die Werte 0 im Nenner und 00 zu treffen sind. 

4. Verfahren nach einem der Anspriiche 1 bis 3 dadurch gekennzeichnet, daB der Wichtungsfaktor Wj fur das i-te 

Gleichungssystem anhand der Determinante der i-ten Untermatnx Ai ermittelt wird: 

60 

Wi Idet (Ai)l 



5. Verfahren nach einem der Anspriiche 1 bis 4, dadurch gekennzeichnet, daB der Wichtungsfaktor Wi fur das i-te 
Gleichungssystem aus einer Konditionszahl der i-ten Untermatrix, beispielsweise aus dem reziproken Wert der 
65 Zweier-Norm-Konditionszahl ermittelt wird: 
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6. Verfahren nach einem der Anspriiche 1 bis 5, dadurch gekennzeichnet, daB die den Wichtungsfaktoren wi zu- 5 
grundeliegende Steuermatrix A und die daraus resuluerenden Untermatrizen A zu verschiedenen Zeiten im ProzeB 
neu bestimmt werden. 

7. Verfahren each einem der Anspriiche 1 bis 6, dadurch gekennzeichnet, daB das Verfahren unter Berucksichu- 
gung eines aktualisierten AusgangsgroBenvektors y zur Ennittlung des jeweils giiltigen Steuervektors u iteriert 
wird. 10 

8. Verfahren nach einem der vorhergehenden Anspriiche, dadurch gekennzeichnet, daB eine Untermenge von Aus- 
gangsgroBen mit potentiell groBeren systematischen Fehlem durch die im laufenden Verfahren mit vergleichs- 
weise geringen Rechenaufwand durchfuhrbare Gewichtung im Vergleich zu einer Untermenge von Ausgangsgro- 
Ben y mit potentiell geringeren systematischen Fehlem weniger Beriicksichtigung finden. 

9. Verfahren zur Steuerung oder Regelung einer zu steuemden Einheit, insbesondere nach einem der Anspriiche 1 15 
bis 8, dadurch gekennzeichnet, daB in einem iiberbestimmten System keine Vorauswahl von Ausgangs- bzw. MeB- 
groBen getroflFen wird, sondem alle Ausgangs- bzw. MeBgroBen mit einer im Verfahren ermittelten Gewichtung zur 
Ermittlung eines Steu^ektors u Beriicksichtigung finden. 

10. Verfahren nach einem der Anspruche 1 bis 9, dadurch gekennzeichnet, daB das Verfahren zur Steuerung von 
Maschinen oder Robotem mit einer beweglichen Komponenle wie einem Greifarm eingesetzt wird, wobei der Aus- 20 
gangsgroBenvektor y zumindest in zwei Dimensionen Entfemungen beinhaltet und der Steuervektor u einen Bewe- 
gungsablauf der beweglichen Komponente, insbesondere des Greifarms steuert. 

11. Verfahren nach einem der Anspruche 1 bis 10, dadurch gekennzeichnet, daB Zustande, Informationen, Aktio- 
nen, etc., durch den Steuervektor u der Dimension n und Zustande, Informationen, Messungen, etc., als Bestandteile 
des AusgangsgroBenvektors y der Dimension m definiert sind. 25 

12. Verfahren zur Steuerung oder Regelung einer zu steuemden Einheit, wobei die zu steuemde Einheit in Abhan- 
gigkeit eines aus einem AusgangsgroBenvektors y zur ermittelnden SteuergroBenvektors u beaufschlagt wird, 
wobei der SteuergroBenvektor u die Dimension n und der AusgangsgroBenvektor y die Dimension m aufweist und 
zumindest m oder n groBer 1 sind, 

wobei der AusgangsgroBenvektor y implizit uber die Matrixgleichung: 30 
y = A • u 

definiert ist, in der y den AusgangsgroBenvektor und A eine Steuermatrix bezeichnet, die sich aus den partiellen Ab- 
leitungen der AusgangsgroBen nach den EingangsgroBen, die entweder bekannt oder beispielsweise durch Tastsi- 35 
gnale ermittelbar sind, ergibt und 

wobei das Steuer- oder Regelungsproblem aufgrund m groBer n iiberbestimmt ist oder aufgrund m kleiner n unter- 

bestimmt ist, 

dadurch gekennzeichnet, 

dafi 40 
max(m,n)! 



min(in,n)[ abs(m-n)! 

Untergleichungssysteme gebildet werden und zur Losung des Steuer- oder Regelungsproblems eine generalisierte 45 
pseudo-inverse Matrix zur Anwendung kommt, in der Hilfsmatrizen eingefuhrt sind, derart, daB fiir das i-te Glei- 
chungssystem ein Summant bestehend aus einem Matrixprodukt (Pi A)"^ Pi im Falle m groBer n und Pi (APi)"^ im 
Falle m kleiner n multipliziert mit einem Wichtungsfaktor [abs (det(Pi A))]^ im FaUe m groBer n und 
[abs(det(APi))]'' im Fall m kleiner n zur Anwendung kommt. 

13. Verfahren nach Anspruch 12, dadurch gekennzeichnet, daB im uberbestimmten Fall m groBer n die generali- 50 
sierte pseudo-inverse Matrix lautet: 

_ X(P,A)-^ P|[abs(det(PiA))r 

A (ia>n) 

Z[abs(det(APi)]^ 55 

14. Verfahren nach Anspruch 12, dadurch gekennzeichnet, daB im unt^bestimmten Fall m kleiner n die gen^ali- 
sierte pseudo-inverse Matrix lautet: 

_ ZPi(APj'[abs(det(P.A))]'« 60 

£ [abs (det(APi)]^ 

15. Verfahren nach einem der vorhergehenden Anspruche, dadurch gekennzeichnet, dafi im Fall m = n - 1 mit der 
Wahl q = 1 eine Losung fur den Steuervektor u, welche die oo-Norm von r = A • u-y direkt minimiert, ermittelbar 
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